home *** CD-ROM | disk | FTP | other *** search
/ Aminet 5 / Aminet 5 - March 1995.iso / Aminet / dev / misc / LEDA_src.lha / LEDA-3.1c-source / src / vga.old / _vgalib.c < prev    next >
Encoding:
C/C++ Source or Header  |  1994-11-17  |  10.6 KB  |  395 lines
  1. /*******************************************************************************
  2. +
  3. +  LEDA  3.1c
  4. +
  5. +
  6. +  _vgalib.c
  7. +
  8. +
  9. +  Copyright (c) 1994  by  Max-Planck-Institut fuer Informatik
  10. +  Im Stadtwald, 6600 Saarbruecken, FRG     
  11. +  All rights reserved.
  12. + 
  13. *******************************************************************************/
  14.  
  15.  
  16.  
  17. #include "vgalib.h"
  18.  
  19. /* 
  20.  * setting the VGA into 640x480x16 color graphics mode or text mode
  21.  * (part of this code is based on "VGAlib" by Tommy Frandsen)
  22.  */
  23.  
  24. VIDEO_PTR  VIDEO=0;
  25.  
  26. int DISP_WIDTH = 640;
  27. int DISP_MAX_X = 639;
  28. int DISP_HEIGHT= 480;
  29. int DISP_MAX_Y = 479;
  30. int DISP_DEPTH = 4;
  31.  
  32. int LINE_BYTES = 80;
  33.  
  34. #define FONT_SIZE  0x2000
  35.  
  36. /* VGA index register ports */
  37. #define CRT_IC  0x3D4   /* CRT Controller Index - color emulation */
  38. #define CRT_IM  0x3B4   /* CRT Controller Index - mono emulation */
  39. #define ATT_IW  0x3C0   /* Attribute Controller Index & Data Write Register */
  40. #define GRA_I   0x3CE   /* Graphics Controller Index */
  41. #define SEQ_I   0x3C4   /* Sequencer Index */
  42. #define PEL_IW  0x3C8   /* PEL Write Index */
  43. #define PEL_IR  0x3C7   /* PEL Read Index */
  44.  
  45. /* VGA data register ports */
  46. #define CRT_DC  0x3D5   /* CRT Controller Data Register - color emulation */
  47. #define CRT_DM  0x3B5   /* CRT Controller Data Register - mono emulation */
  48. #define ATT_R   0x3C1   /* Attribute Controller Data Read Register */
  49. #define GRA_D   0x3CF   /* Graphics Controller Data Register */
  50. #define SEQ_D   0x3C5   /* Sequencer Data Register */
  51. #define MIS_R   0x3CC   /* Misc Output Read Register */
  52. #define MIS_W   0x3C2   /* Misc Output Write Register */
  53. #define IS1_RC  0x3DA   /* Input Status Register 1 - color emulation */
  54. #define IS1_RM  0x3BA   /* Input Status Register 1 - mono emulation */
  55. #define PEL_D   0x3C9   /* PEL Data Register */
  56.  
  57. /* VGA indexes max counts */
  58. #define CRT_C   24      /* 24 CRT Controller Registers */
  59. #define ATT_C   21      /* 21 Attribute Controller Registers */
  60. #define GRA_C   9       /* 9  Graphics Controller Registers */
  61. #define SEQ_C   5       /* 5  Sequencer Registers */
  62. #define MIS_C   1       /* 1  Misc Output Register */
  63.  
  64. /* VGA registers saving indexes */
  65. #define CRT     0               /* CRT Controller Registers start */
  66. #define ATT     CRT+CRT_C       /* Attribute Controller Registers start */
  67. #define GRA     ATT+ATT_C       /* Graphics Controller Registers start */
  68. #define SEQ     GRA+GRA_C       /* Sequencer Registers */
  69. #define MIS     SEQ+SEQ_C       /* General Registers */
  70. #define END     MIS+MIS_C       /* last */
  71.  
  72.  
  73. /* variables used to shift between monchrome and color emulation */
  74. static int CRT_I;        /* current CRT index register address */
  75. static int CRT_D;        /* current CRT data register address */
  76. static int IS1_R;        /* current input status register address */
  77. static int color_text;        /* true if color text emulation */
  78.  
  79.  
  80. /* BIOS mode 12h - 640x480x16 */
  81. static char g640x480x16_regs[60] = {
  82.   0x5F,0x4F,0x50,0x82,0x54,0x80,0x0B,0x3E,0x00,0x40,0x00,0x00,
  83.   0x00,0x00,0x00,0x00,0xEA,0x8C,0xDF,0x28,0x00,0xE7,0x04,0xE3,
  84.   0x00,0x01,0x02,0x03,0x04,0x05,0x06,0x07,0x08,0x09,0x0A,0x0B,
  85.   0x0C,0x0D,0x0E,0x0F,0x01,0x00,0x0F,0x00,0x00,
  86.   0x00,0x0F,0x00,0x20,0x00,0x00,0x05,0x0F,0xFF,
  87.   0x03,0x01,0x0F,0x00,0x06,
  88.   0xE3
  89. };
  90.  
  91.  
  92. /* default RGB values */
  93.  
  94. //                            white black red  green blue  yellow violet orange
  95. //                            cyan  brown pink green grey1 grey2  grey3  grey4
  96. static char RGB_RED[16]  = {  63,   0,    63,   0,   0,    54,    42,    54,   
  97.                                0,  48,    63,   9,   45,   40,    35,     0};
  98.  
  99. static char RGB_GREEN[16]= {  63,   0,     0,  54,    0,   54,    21,    36,  
  100.                               63,  28,    26,  35,   45,   40,    35,     0};
  101.  
  102. static char RGB_BLUE[16] = {  63,   0,     0,   0,   63,   18,    63,     0, 
  103.                               63,  18,    47,   9,   45,   40,    35,     0};
  104.  
  105.  
  106. static char text_regs[60];   /* VGA registers for saved text mode */
  107.  
  108. /* saved text mode palette values */
  109. static char text_red[256];
  110. static char text_green[256];
  111. static char text_blue[256];
  112.  
  113. /* saved graphics mode palette values */
  114. //static char graph_red[256];
  115. //static char graph_green[256];
  116. //static char graph_blue[256];
  117.  
  118. static int initialized = 0;
  119.  
  120. static char font_buf1[FONT_SIZE];  /* saved font data - plane 2 */
  121. static char font_buf2[FONT_SIZE];  /* saved font data - plane 3 */
  122.  
  123.  
  124. static void set_regs(char regs[])
  125. {
  126.     int i;
  127.  
  128.     /* disable video */
  129.     port_in(IS1_R);    
  130.     port_out(0x00, ATT_IW);
  131.  
  132.     /* update misc output register */
  133.     port_out(regs[MIS], MIS_W);
  134.  
  135.     /* synchronous reset on */
  136.     port_out(0x00,SEQ_I);
  137.     port_out(0x01,SEQ_D);    
  138.  
  139.     /* write sequencer registers */
  140.     for (i = 1; i < SEQ_C; i++) {
  141.     port_out(i, SEQ_I);
  142.     port_out(regs[SEQ+i], SEQ_D);
  143.     }
  144.  
  145.     /* synchronous reset off */
  146.     port_out(0x00, SEQ_I);
  147.     port_out(0x03, SEQ_D);    
  148.  
  149.     /* deprotect CRT registers 0-7 */
  150.     port_out(0x11, CRT_I);        
  151.     port_out(port_in(CRT_D)&0x7F, CRT_D);
  152.  
  153.     /* write CRT registers */
  154.     for (i = 0; i < CRT_C; i++) {
  155.     port_out(i, CRT_I);
  156.     port_out(regs[CRT+i], CRT_D);
  157.     }
  158.  
  159.     /* write graphics controller registers */
  160.     for (i = 0; i < GRA_C; i++) {
  161.     port_out(i, GRA_I);
  162.     port_out(regs[GRA+i], GRA_D);
  163.     }
  164.  
  165.     /* write attribute controller registers */
  166.     for (i = 0; i < ATT_C; i++) {
  167.     port_in(IS1_R);   /* reset flip-flop */
  168.     port_out(i, ATT_IW);
  169.     port_out(regs[ATT+i],ATT_IW);
  170.     }
  171. }
  172.  
  173.  
  174. static void vga_initialize()
  175. {
  176.     int  i, j;
  177.  
  178.     if (initialized) return;
  179.  
  180.     initialized = 1;
  181.  
  182. #if defined(__GNUG__)
  183.     VIDEO = (VIDEO_PTR)0xd0000000;
  184. #else
  185. #if defined(__ZTC__) && defined(DOS386)
  186.     VIDEO = (VIDEO_PTR)_x386_mk_protected_ptr(0xa0000);
  187. #else
  188.     VIDEO = (VIDEO_PTR)MK_FP(0xa000,0);
  189. #endif
  190. #endif
  191.  
  192.  
  193.     /* color or monochrome text emulation? */
  194.     color_text = port_in(MIS_R)&0x01;
  195.  
  196.     /* chose registers for color/monochrome emulation */
  197.     if (color_text) {
  198.     CRT_I = CRT_IC;
  199.     CRT_D = CRT_DC;
  200.     IS1_R = IS1_RC;
  201.     } else {
  202.     CRT_I = CRT_IM;
  203.     CRT_D = CRT_DM;
  204.     IS1_R = IS1_RM;
  205.     }
  206.  
  207.     /* disable video */
  208.     port_in(IS1_R);    
  209.     port_out(0x00, ATT_IW);
  210.  
  211.     /* save text mode palette - first select palette index 0 */
  212.     port_out(0, PEL_IR);
  213.  
  214.     /* read RGB components - index is autoincremented */
  215.     for(i = 0; i < 256; i++) {
  216.     for(j = 0; j < 10; j++) ;   /* delay (minimum 240ns) */
  217.     text_red[i] = port_in(PEL_D);
  218.     for(j = 0; j < 10; j++) ;   /* delay (minimum 240ns) */
  219.     text_green[i] = port_in(PEL_D);
  220.     for(j = 0; j < 10; j++) ;   /* delay (minimum 240ns) */
  221.     text_blue[i] = port_in(PEL_D);
  222.     }
  223.  
  224.     /* save text mode VGA registers */
  225.     for (i = 0; i < CRT_C; i++) {
  226.      port_out(i, CRT_I);
  227.      text_regs[CRT+i] = port_in(CRT_D);
  228.     }
  229.     for (i = 0; i < ATT_C; i++) {
  230.            port_in(IS1_R);
  231.          port_out(i, ATT_IW);
  232.          text_regs[ATT+i] = port_in(ATT_R);
  233.     }
  234.     for (i = 0; i < GRA_C; i++) {
  235.             port_out(i, GRA_I);
  236.             text_regs[GRA+i] = port_in(GRA_D);
  237.     }
  238.     for (i = 0; i < SEQ_C; i++) {
  239.             port_out(i, SEQ_I);
  240.             text_regs[SEQ+i] = port_in(SEQ_D);
  241.     }
  242.     text_regs[MIS] = port_in(MIS_R);
  243.  
  244.     /* shift to color emulation */
  245.     CRT_I = CRT_IC;
  246.     CRT_D = CRT_DC;
  247.     IS1_R = IS1_RC;
  248.     port_out(port_in(MIS_R)|0x01, MIS_W);
  249.  
  250.     /* save font data - first select a 16 color graphics mode */
  251.     set_regs(g640x480x16_regs);
  252.  
  253.     /* save font data in plane 2 */
  254.     port_out(0x04, GRA_I);
  255.     port_out(0x02, GRA_D);
  256.     for(i = 0; i < FONT_SIZE; i++) font_buf1[i] = VIDEO[i];
  257.  
  258.     /* save font data in plane 3 */
  259.     port_out(0x04, GRA_I);
  260.     port_out(0x03, GRA_D);
  261.     for(i = 0; i < FONT_SIZE; i++) font_buf2[i] = VIDEO[i];
  262. }
  263.  
  264.  
  265. void set_palette(int index, int red, int green, int blue)
  266. {
  267.     int i;
  268.  
  269.     /* select palette register */
  270.     port_out(index, PEL_IW);
  271.  
  272.     /* write RGB components */
  273.     for(i = 0; i < 10; i++) ;   /* delay (minimum 240ns) */
  274.     port_out(red, PEL_D);
  275.     for(i = 0; i < 10; i++) ;   /* delay (minimum 240ns) */
  276.     port_out(green, PEL_D);
  277.     for(i = 0; i < 10; i++) ;   /* delay (minimum 240ns) */
  278.     port_out(blue, PEL_D);
  279. }
  280.  
  281.  
  282. void get_palette(int index, int *red, int *green, int *blue)
  283. {
  284.     int i;
  285.  
  286.     /* select palette register */
  287.     port_out(index, PEL_IR);
  288.  
  289.     /* read RGB components */
  290.     for(i = 0; i < 10; i++) ;   /* delay (minimum 240ns) */
  291.     *red = (int) port_in(PEL_D);
  292.     for(i = 0; i < 10; i++) ;   /* delay (minimum 240ns) */
  293.     *green = (int) port_in(PEL_D);
  294.     for(i = 0; i < 10; i++) ;   /* delay (minimum 240ns) */
  295.     *blue = (int) port_in(PEL_D);
  296. }
  297.  
  298. static void vga_clear(int c)
  299. {
  300.   register VIDEO_PTR p;
  301.   register VIDEO_PTR last;
  302.  
  303.   /* set color c */
  304.   port_out(c, GRA_I );
  305.   port_out(0, GRA_D );
  306.  
  307.   /* set mode 0 */
  308.   port_out(0x03, GRA_I );
  309.   port_out(0, GRA_D );
  310.  
  311.   /* write to all bits */
  312.   port_out(0x08, GRA_I );
  313.   port_out(0xFF, GRA_D );
  314.  
  315.   last  = VIDEO + DISP_HEIGHT*LINE_BYTES;
  316.  
  317.   for(p = VIDEO; p < last; p++)  *p = 0;
  318.  
  319. }
  320.  
  321.  
  322. void vga_init(int mode, int root_col)  // mode = 0: Text, 1: 640x480x16 
  323. {
  324.     int i;
  325.  
  326.     vga_initialize();
  327.     
  328.     if (mode == 0)  // TEXT
  329.       { 
  330.         /* restore font data - first select a 16 color graphics mode */
  331.         set_regs(g640x480x16_regs);
  332.  
  333.     /* disable Set/Reset Register */
  334.         port_out(0x01, GRA_I );
  335.         port_out(0x00, GRA_D );
  336.  
  337.         /* restore font data in plane 2 - necessary for all VGA's */
  338.         port_out(0x02, SEQ_I );
  339.         port_out(0x04, SEQ_D );
  340.         for(i = 0; i < FONT_SIZE; i++) VIDEO[i] = font_buf1[i];
  341.  
  342.         /* restore font data in plane 3 - necessary for Trident VGA's */
  343.         port_out(0x02, SEQ_I );
  344.         port_out(0x08, SEQ_D );
  345.         for(i = 0; i < FONT_SIZE; i++) VIDEO[i] = font_buf2[i];
  346.  
  347.         /* change register adresses if monochrome text mode */
  348.         if (!color_text) {
  349.             CRT_I = CRT_IM;
  350.             CRT_D = CRT_DM;
  351.             IS1_R = IS1_RM;
  352.             port_out(port_in(MIS_R)&0xFE, MIS_W);
  353.         }
  354.  
  355.     /* restore text mode VGA registers */
  356.         set_regs(text_regs);
  357.  
  358.         /* restore saved palette */
  359.         for(i = 0; i < 256; i++)
  360.             set_palette(i, text_red[i], text_green[i], text_blue[i]);
  361.  
  362.         DISP_WIDTH = 80;
  363.         DISP_MAX_X = 79;
  364.         DISP_HEIGHT= 25;
  365.         DISP_MAX_Y = 24;
  366.       }
  367.     else // graphics mode
  368.       { 
  369.         /* shift to color emulation */
  370.         CRT_I = CRT_IC;
  371.         CRT_D = CRT_DC;
  372.         IS1_R = IS1_RC;
  373.         port_out(port_in(MIS_R)|0x01, MIS_W);
  374.         set_regs(g640x480x16_regs);
  375.  
  376.         /* set default palette */
  377.         for(i = 0; i < 16; i++)
  378.           set_palette(i, RGB_RED[i], RGB_GREEN[i], RGB_BLUE[i]);
  379.  
  380.         vga_clear(root_col);
  381.  
  382.         LINE_BYTES = 80;
  383.         DISP_WIDTH = 640;
  384.         DISP_MAX_X = 639;
  385.         DISP_HEIGHT= 480;
  386.         DISP_MAX_Y = 479;
  387.         DISP_DEPTH = 4;
  388.       }
  389.  
  390.     /* enable video */
  391.     port_in(IS1_R);
  392.     port_out(0x20, ATT_IW);
  393.  
  394. }
  395.